Servo Control Device

ABSTRACT

An object of the invention is to provide a servo control device capable of making zero the positional deviation the positional deviation at a constant speed as well as the positional deviation at a constant acceleration or at constant acceleration and jerk, thereby providing a high-precision follow-up response.  
     In order to solve this problem, the servo control device according to the invention includes a position controller ( 3 ) for generating a speed command that matches the motor output with a target position, a feed-forward controller ( 4 ) for adding a signal obtained by multiplying the differential of a target command by a gain and a signal obtained by multiplying the second-order differentiation of the target command by a gain and generating a speed feed-forward signal, and a speed controller ( 2 ) for performing I-P or PI control of the motor ( 1 ).

TECHNICAL FIELD

The present invention relates to a servo control device for driving a machine tool, semiconductor manufacturing equipment, or a mounting device that requires high instruction tracking accuracy.

BACKGROUND ART

Various arrangements are proposed as a servo control device that provides motor output matching a target instruction.

FIG. 3 is a block diagram showing the configuration of a servo control device disclosed in Patent Reference 1. In FIG. 3, a numeral 1 represents a motor, 2 a speed controller, 5′ a predictive controller, 6 a differentiator, and 50 a feed-forward (FF) signal creating command filter.

When a future target command is input to the FF signal creating command filter 50, the signal creating command filter 50 creates a speed feed-forward signal V_(FF), a torque feed-forward signal T_(FF), a position command increment value Δr, outputs the speed feed-forward signal V_(FF), the torque feed-forward signal T_(FF), the position command increment value Δr to the predictive controller 5′ and outputs the speed feed-forward signal V_(FF) and the torque feed-forward signal T_(FF) to the speed controller 2. The predictive controller 2 inputs a position command increment value Δr, a speed feed-forward signal V_(FF), a torque feed-forward signal T_(FF) and an increment value of motor position, creates and outputs a speed command to the speed controller 2. The speed controller 2 inputs the speed command, the speed feed-forward signal V_(FF) and the torque feed-forward signal T_(FF) and feeds power to a motor. The motor 1 receives power from the speed controller and generates a torque, and generates acceleration according to the inertia or a load.

FIG. 4 is a block diagram of a feed-forward signal creating command filter 50. In FIG. 4, a numeral 21 represents a filter, 22 a feed-forward signal arithmetic unit, and 23 a memory.

The filter 21 is a filter that can be used to filter a future target command and outputs a filtered future target command. The memory 23 inputs the output of the filter 21, stores target command increment values Δr(i), . . . , Δr(i+M) from the current time i to M sampling future (M is a natural number) and outputs the target command increment values to an FF signal arithmetic unit 22 and a predictive controller 5′. The FF signal arithmetic unit 22 inputs the output of the memory 23, creates a speed feed-forward signal V_(FF) and a torque feed-forward signal T_(FF) and outputs the signals to the predictive controller 5′ and the speed controller 2.

FIG. 2 is a block diagram a modified version of the configuration of the servo control device disclosed in Patent Reference 1 and includes a second feed-forward controller 40, a predictive controller 5, a speed controller 2, a motor 1, and a differentiator 6 so as to match the output of the motor 1 with a target command. FIG. 3 is different from FIG. 2 in that a target command increment value Δr to be stored into a memory 23 is directly input to the second feed-forward controller 40 and the predictive controller 5 irrespective of the presence of a filter in the feed-forward signal creating command filter 50 and that the FF signal arithmetic unit 22 computes and outputs only the speed feed-forward signal V_(FF) and each of the second feed-forward controller 40 and the predictive controller 5 includes the FF signal arithmetic unit 22 and the memory 23. Thus, the speed feed-forward signal V_(FF)(i) output from the second feed-forward controller 40 is output the speed controller 2 alone.

FIG. 6 is a block diagram showing the configuration of a second feed-forward controller 40. Referring to FIG. 6, the feed-forward controller 40 includes a memory 23 and an FF signal arithmetic unit 22. The memory 23 sequentially stored target command increment values to store command increment values Δr(i), Δr(i+1), . . . , Δr(i+M) from the current time i to the M sampling future (M is a natural number) and outputs the command increment values to the FF signal arithmetic unit 22. The FF signal arithmetic unit 22 obtains and outputs a speed feed-forward signal V_(FF)(i) from the command increment values Δr(i), Δr(i+1), . . . , Δr(i+M) output from the memory 23. The arithmetic expression to obtain a speed feed-forward signal is not limited. For example, disturbance applied to the motor 1 is known, the disturbance may be canceled with arithmetic operation or assume V _(FF)(i)=ffv/Ts·Δr(i+m1) where ffv is a feed-forward gain, Ts is a sampling period, Δr(i+m1) is a command increment value of the m1 sampling future, and m1 is an integer in the range of 0≦m1.

FIG. 5 is a block diagram showing the configuration of a predictive controller 5. The predictive controller 5 inputs a command increment value Δr(i) and a position output increment value Δy(i-K) as an increment value of the sampling period of the position output of K (K is an integer≧0) sampling past of a motor 1, obtains a future deviation predicted value by using a transfer function model from a speed command to output, and determines and output a speed command u(i) so that the evaluation function concerning the future deviation predicted value and the speed command u(i) will be minimum.

Referring to FIG. 5, the predictive controller 5 includes a FF signal arithmetic unit 22, memories 23, 101, 102, 103, 104, 105, an arithmetic unit 106, a subtracter 108, and an integrator 109. The memory 23 and the FF signal arithmetic unit 22 are the same as the memory 23 and the FF signal arithmetic unit 22 shown in FIG. 6 and V_(FF)(i) is output from the FF signal arithmetic unit 22. The memory 103 inputs future command increment values Δr(i+1), Δr(i+2), . . . , Δr(i+M) as output of the memory 23 and stores past command increment values Δr(i−1), Δr(i−2), . . . , Δr(i−K). The memory 102 stores constants for predictive control v_(m)(m=−K+1,−K+2, . . . M), p_(n)(n=0, 1, . . . , Na), E, g_(n)(n=1, . . . Nb+K−1), x_(n)(n=0, 1, . . . Nd+K−1) where Na, Nb and Nd are natural numbers. The memory 104 has a position output increment value Δy(i−K) as an input and stores past output increment values Δy(i-K), Δy(i−K−1), . . . , Δy(i−K−Na+1). The memory 105 has the speed command u(i) as an input and stores the past speed commands u(i−1), u(i−2), . . . , u(i−K−Nb+1). The memory 101 has as an input the output of the FF signal arithmetic unit 22 and stores V_(FF)(i), V_(FF)(i−1), . . . , (i−K−Nd+1). The subtracter 108 obtains a deviation increment value between the command increment value Δr(i−K) stored in the memory 103 and the position output increment value Δy(i−K). The integrator 109 integrates a deviation increment value as an output of the subtracter 108 to obtain a deviation e(i−K). The arithmetic unit 106 calculates the speed command u(i) at the current time and outputs the speed command u(i) to the speed controller 2. $\begin{matrix} \left\lbrack {{Formula}\quad 1} \right\rbrack & \quad \\ {{u(i)} = {{\sum\limits_{m = {K + 1}}^{M}\quad{v_{m}\Delta\quad{r\left( {i + m} \right)}}} - {\sum\limits_{n = 0}^{{N\quad a} - 1}\quad{p_{n}\Delta\quad{y\left( {i - K - n} \right)}}} + {E\quad{e\left( {i - K} \right)}} - {\sum\limits_{n = 1}^{{N\quad b} + K - 1}\quad{g_{n}{u\left( {i - n} \right)}}} - {\sum\limits_{n = 0}^{{N\quad d} + K - 1}\quad{x_{n}{V_{F\quad F}\left( {i - n} \right)}}}}} & (1) \end{matrix}$

Next, Expression (1) is described below.

Assume that the discrete-time transmission function model from the speed feed-forward signal V_(FF)(i) and speed command u(i) input to the speed controller 2 to the position output y(i) of the motor 1 is obtained as $\begin{matrix} \left\lbrack {{Formula}\quad 2} \right\rbrack & \quad \\ {{y(z)} = \frac{\begin{matrix} {{\left( {{b_{1}z^{- 1}} + \ldots + {b_{N\quad b}z^{{- N}\quad b}}} \right){u(z)}} +} \\ {\left( {{d_{1}z^{- 1}} + \ldots + {d_{N\quad d}z^{{- N}\quad d}}} \right){V_{F\quad F}(z)}} \end{matrix}}{\left( {1 - z^{- 1}} \right)\left( {1 - {a_{1}z^{- 1}} - \ldots - {a_{N\quad a}z^{{- N}\quad a}}} \right)}} & (2) \end{matrix}$

where y(z), u(z) and V_(FF)(z) are respectively z conversions of y(1), u(i) and V_(FF)(i).

Expression (1) is obtained when the speed command u(i) is determined so that the evaluation function $\begin{matrix} \left\lbrack {{Formula}\quad 3} \right\rbrack & \quad \\ {J = {{\sum\limits_{m = 1}^{M}\quad{w_{m}\left\{ {{e^{*}\left( {i + m} \right)} + {\alpha\quad{e\left( {i - K} \right)}}} \right\}^{2}}} + {c\left\{ {u(i)} \right\}^{2}} + {c_{d}\left\{ {\Delta\quad{u(i)}} \right\}^{2}}}} & (3) \end{matrix}$

will be minimum, wherein e*(i+m) is a deviation predicted value at an m sampling future time, w_(m), a are coefficients to multiply a deviation by, c and c_(d) are coefficients to multiply a speed command u(i) and its increment value Δu(i). The constants v_(m), E, P_(n), g_(n), X_(n) in Expression (1) are given by $\begin{matrix} {{{\beta_{s} = {\sum\limits_{j = 1}^{s}\quad B_{j\quad 0}}},\quad{W = {{\sum\limits_{s\quad = \quad 1}^{\quad M}\quad{w_{\quad s}\beta_{\quad s}^{\quad 2}}} + c + c_{\quad d}}},{q_{s} = {w_{s}{\beta_{s}/W}}}}{{v_{m} = {\sum\limits_{s = m}^{M}\quad q_{s}}},\quad{m = {{- K} + 1}},{{- K} + 2},\ldots\quad,M}{E = {\left( {1 + \alpha} \right)v_{1}}}{{p_{n} = {{\sum\limits_{m = {{- K} + 1}}^{M}\quad{v_{m}A_{m{({n + K})}}\quad n}} = 0}},1,\ldots\quad,{{N\quad a} - 1}}{{g_{1} = {{\sum\limits_{m = {{- K} + 1}}^{M}\quad{v_{m}B_{m\quad 1}}} - {c_{d}/W}}},{g_{\quad n} = {{\sum\limits_{m\quad = \quad{{- K}\quad + \quad 1}}^{\quad M}\quad{v_{\quad m}B_{\quad m}\quad n}} = 2}},\ldots\quad,{{N\quad b} + K - 1}}{{x_{n} = {{\sum\limits_{m = {{- K} + 1}}^{M}\quad{v_{m}D_{m\quad n}\quad n}} = 0}},1,\ldots\quad,{{N\quad d} + K - 1}}} & \left\lbrack {{Formula}\quad 4} \right\rbrack \end{matrix}$

where A_(mn), B_(mn), D_(mn) are coefficients calculated from the coefficients of the discrete time transfer function model a₁-a_(Na), b₁-b_(Nb), d₁-d_(Nd).

In this way, the related art servo control device controls a motor by using the speed command u(i) output from the predictive controller 5 and the speed feed-forward signal V_(FF)(i) output from the second feed-forward controller 40.

As a servo control device that matches a target command with motor output, a position proportional controller may be used instead of the predictive controller 5 in FIG. 1. In this case, the deviation between the target command and the position output of the motor are proportionally multiplied to obtain a speed command.

Patent Document: JP-A-2002-62906

DISCLOSURE OF THE INVENTION Problems to be Solved by the Invention

The related art servo control device can use a speed command u(i) created by the predictive controller 5 and a speed feed-forward signal V_(FF)(i) created by the second feed-forward controller 40 to make zero the positional deviation at a constant speed. This involves a problem that it is impossible to make zero the positional deviation at a constant acceleration or at constant acceleration and jerk (time differentiation of acceleration).

While a servo control device that inputs a signal obtained by differentiating a target command as a speed feed-forward signal V_(FF)(i) for position proportional control, speed PI control or speed I-P control can make zero the deviation at a constant speed or a constant acceleration, such a servo control device cannot make zero the deviation at a constant speed or constant acceleration and jerk with a control target having a viscous friction in the motor.

The invention is accomplished in view of these problems. An object of the invention is to provide a servo control device capable of making zero the positional deviation the positional deviation at a constant speed as well as the positional deviation at a constant acceleration or at constant acceleration and jerk, thereby providing a high-precision follow-up response.

Means for Solving the Problems

According to claim 1 of the invention, there is provided a servo control device including:

a speed controller for performing speed control of a motor;

a position controller for inputting a target command increment value as an increment of the sampling period of a target command and a position output increment value as an increment of the sampling period of the position output of the motor and outputting a speed command to the speed controller; and

a first feed-forward controller for inputting the target command increment value and outputting a first speed feed-forward signal to the speed controller; wherein

the first feed-forward controller adds a third speed feed-forward signal obtained by multiplying the second-order differentiation of the target command by a control gain to a second speed feed-forward signal V_(FF), outputs as a first speed feed-forward signal V_(F2) the resulting signal to the speed controller and sets the control gain so that the deviation between the target position and the position output of the motor will be zero at a constant acceleration.

According to claim 2 of the invention, there is provided a servo control device including:

a speed controller for performing speed control of a motor;

a position controller for inputting a target command increment value as an increment of the sampling period of a target command and a position output increment value as an increment of the sampling period of the position output of the motor and outputting a speed command to the speed controller; and

a first feed-forward controller for inputting the target command increment value and outputting a first speed feed-forward signal to the speed controller; wherein

the first feed-forward controller adds a third speed feed-forward signal obtained by multiplying the second-order differentiation of the target command by a control gain to a second speed feed-forward signal V_(FF), outputs as a first speed feed-forward signal V_(F2) the resulting signal to the speed controller and sets the control gain so that the deviation between the target position and the position output of the motor will be zero at a constant acceleration and, when the target command increment value Δr is equal to or below a preset threshold at deceleration, makes zero or multiplies the output of the third feed-forward signal by a present gain and outputs the resulting signal.

According to claim 3 of the invention, there is provided the servo control device according to claim 1, wherein

the first feed-forward controller generates a speed feed-forward signal V_(F2) in accordance with the expression $\begin{matrix} {V_{F\quad 2} = {{\frac{K_{2}}{T\quad s^{2}}\left( {1 - z^{- 1}} \right)\Delta\quad r} + V_{F\quad F}}} & \left\lbrack {{Formula}\quad 5} \right\rbrack \end{matrix}$

where Δr is the target command increment value, Ts a sampling period, K₂ a control gain set so that the deviation between the target position and the position output of the motor will be zero, and z⁻¹ a delay corresponding to one sampling period, and

outputs the signal to the speed controller.

According to claim 4 of the invention, there is provided the servo control device according to claim 2, wherein

the first feed-forward controller generates a speed feed-forward signal V_(F2) in accordance with the expression $\begin{matrix} {V_{F\quad 2} = {{\frac{K_{2}}{T\quad s^{2}}\left( {1 - z^{- 1}} \right)\Delta\quad r} + V_{F\quad F}}} & \left\lbrack {{Formula}\quad 6} \right\rbrack \end{matrix}$

where Δr is the target command increment value, Ts a sampling period, K₂ a control gain set so that the deviation between the target position and the position output of the motor will be zero, and z⁻¹ a delay corresponding to one sampling period and,

only when the target command increment value Δr is equal to or below a preset threshold at deceleration, generates a speed feed-forward signal V_(F2) in accordance with the expression $\begin{matrix} {V_{F\quad 2} = {{V_{F\quad F}\quad{or}\quad V_{F\quad 2}} = {{\frac{K_{2}K_{3}}{T\quad s^{2}}\left( {1 - z^{- 1}} \right)\Delta\quad r} + V_{F\quad F}}}} & \left\lbrack {{Formula}\quad 7} \right\rbrack \end{matrix}$

where K₃ is a gain, and

outputs the signal to the speed controller.

According to claim 5 of the invention, there is provided the servo control device according to claim 1 or 2, wherein

the position controller is a predictive controller for inputting the target command increment value Δr(i+M) at an M sampling future and the position output increment value Δr(i−K) before K (K≧0) sampling at the current time I, and outputting a speed command u(i) that minimizes the evaluation function (3).

According to claim 6 of the invention, there is provided the servo control device according to claim 3 or 4, wherein

the position controller has the characteristic of the transfer function $\begin{matrix} {u = {{\frac{V_{sum} - {\frac{ffv}{{T\quad s}\quad}{X(z)}} + \frac{E}{1 - z^{- 1}}}{1 + {G(z)}}\Delta\quad r} - {\frac{\frac{E}{1 - z^{- 1}} + P_{0}}{1 + {G(z)}}\Delta\quad y}}} & \left\lbrack {{Formula}\quad 8} \right\rbrack \end{matrix}$

where u is the speed command, Δy the position output increment value, E a control parameter, ffv a feed-forward gain, and V_(sum), G(z), X(z), P₀ are respectively V _(sum) =v _(sum) /{K _(gv)(1+C _(D))} G(z)=(g ₁ *−C _(D))z ⁻¹/(1+C _(D)) X(z)=(1+g ₁ *·z ⁻¹/(1+C _(D)) P ₀=(−1−g ₁ *+T _(s) v _(sum))/{K _(gv) T _(s)(1+C _(D))} and

g₁*, v_(sum), C_(D) are controller parameters and K_(gv) a constant gain from a speed command to a speed feedback.

According to claim 7 of the invention, there is provided the servo control device according to claim 6, wherein

the speed controller is an I-P controller,

the speed feed-forward signal in the feed-forward controller is given from a feed-forward gain ffv by V _(FF) =ffv/Ts·Δr, and

K₂ as a control gain is given by K ₂ =T _(i)·(1−ffv)+T _(s) {C _(D)(1−ffv)−g ₁*}/(1+g ₁*)+D·T _(i)/(J·K _(v))

where D is a viscous friction coefficient, Jmotor inertia, T_(i) a speed loop integration time in the speed controller, and K_(v) a speed loop gain in the speed controller.

According to claim 8 of the invention, there is provided the servo control device according to claim 6, wherein

the speed controller is a PI controller,

the second speed feed-forward signal V_(FF) in the first feed-forward controller is given from the feed-forward gain ffv by V _(FF) =ffv/Ts·Δ r, and

K₂ as a control gain is given by K ₂ =T _(s) {C _(D)(1−ffv)−g ₁*}/(1+g ₁*)+D·T _(i)/(J·K _(v))

where D is a viscous friction coefficient, Jmotor inertia, T_(i) a speed loop integration time in the speed controller, and K_(v) a speed loop gain in the speed controller.

According to claim 9 of the invention, there is provided the servo control device according to claim 3 or 4, wherein

the position controller is a proportional controller,

the speed controller is a PI controller or an I-P controller, and

the speed feed-forward signal V_(FF) in the feed-forward controller is given from the feed-forward gain ffv by V _(FF) =ffv/Ts·Δr and

K₂ and ffv as parameters are given by K ₂ =D·T _(i)/(J·K _(v))

ffv=1

where D is a viscous friction coefficient, Jmotor inertia, T_(i) a speed loop integration time in the speed controller, and K_(v) a speed loop gain in the speed controller.

According to claim 10 of the invention, there is provided a servo control device that makes control so as to match the output of a motor having viscous friction with a target command, the device including:

a speed controller for performing speed control of the motor;

a position controller for inputting a target command increment value as an increment of the sampling period of the target command and a position output increment value as an increment of the sampling period of the position output of the motor and outputting a speed command to the speed controller; and

a feed-forward controller for inputting the target command increment value and outputting a speed feed-forward signal to the speed controller; wherein

the feed-forward controller adds a third speed feed-forward signal obtained by multiplying the second-order differentiation of the target command by a control gain to a second speed feed-forward signal V_(FF), and outputs as a speed feed-forward signal V_(F2) the resulting signal, and

the gain ffv and the gain K₂ are set so that the deviation between the target command and the position output of the motor will be zero at a constant acceleration and at a constant jerk.

According to claim 11 of the invention, there is provided a servo control device that makes control so as to match the output of a motor having viscous friction with a target command, the device including:

a speed controller for performing speed control of the motor;

a position controller for inputting a target command increment value as an increment of the sampling period of the target command and a position output increment value as an increment of the sampling period of the position output of the motor and outputting a speed command to the speed controller; and

a feed-forward controller for inputting the target command increment value and outputting a speed feed-forward signal to the speed controller; wherein

the feed-forward controller adds a third speed feed-forward signal obtained by multiplying the second-order differentiation of the target command by a control gain to a second speed feed-forward signal V_(FF) and outputs as a speed feed-forward signal V_(F2) the resulting signal,

the gain ffv and the gain K₂ are set so that the deviation between the target command and the position output of the motor will be zero at a constant acceleration and at a constant jerk, and

when the target command increment value Δr is equal to or below a preset threshold at deceleration, the feed-forward controller makes zero the gain K₂ or sets a gain obtained by multiplying the gain K₂ by a preset gain K₃.

According to claim 12 of the invention, there is provided the servo control device according to claim 10, wherein

the feed-forward controller is a feed-forward controller that generates the speed feed-forward signal V_(F2) in accordance with $\begin{matrix} {V_{F\quad 2} = {{\frac{K_{2}}{T\quad s^{2}}\left( {1 - z^{- 1}} \right)\Delta\quad r} + V_{F\quad F}}} & \left\lbrack {{Formula}\quad 9} \right\rbrack \end{matrix}$

where Δr is the target command increment value, Ts a sampling period, K₂ a control gain, and z⁻¹ a delay corresponding to one sampling period.

According to claim 13 of the invention, there is provided the servo control device according to claim 11, wherein

the feed-forward controller is a feed-forward controller that generates the speed feed-forward signal V_(F2) in accordance with $\begin{matrix} {V_{F\quad 2} = {{\frac{K_{2}}{T\quad s^{2}}\left( {1 - z^{- 1}} \right)\Delta\quad r} + V_{F\quad F}}} & \left\lbrack {{Formula}\quad 10} \right\rbrack \end{matrix}$

where Δr is the target command increment value, Ts a sampling period, K₂ a control gain, and z⁻¹ a delay corresponding to one sampling period, and

when the target command increment value is equal to or below a preset threshold at deceleration, generates a speed feed-forward signal V_(F2) in accordance with the expression $\begin{matrix} {V_{F\quad 2} = {{V_{FF}{\quad\quad}{or}\quad V_{F\quad 2}} = {{\frac{K_{2}K_{3}}{T\quad s^{2}}\left( {1 - z^{- 1}} \right)\Delta\quad r} + V_{FF}}}} & \left\lbrack {{Formula}\quad 11} \right\rbrack \end{matrix}$

where K₃ is a gain.

According to claim 14 of the invention, there is provided the servo control device according to claim 10 or 11, wherein

the position controller is a predictive controller for inputting the target command increment value Δr(i+M) at an M sampling future and the position output increment value Δr(i−K) before K (K≧0) sampling at the current time I, and outputting a speed command u(i) that minimizes the evaluation function $\begin{matrix} {J = {{\sum\limits_{m = 1}^{M}\quad{w_{m}\left\{ {{e^{*}\left( {i + m} \right)} + {\alpha\quad{e\left( {i - K} \right)}}} \right\}^{2}}} + {c\left\{ {u(i)} \right\}^{2}} + {c_{d}\left\{ {\Delta\quad{u(i)}} \right\}^{2}}}} & \left\lbrack {{Formula}\quad 12} \right\rbrack \end{matrix}$

will be minimum, wherein e*(i+m) is a deviation predicted value at an m sampling future time, w_(m), α are coefficients to multiply a deviation by, c and c_(d) are coefficients to multiply a speed command u(i) and its increment value Δu(i).

According to claim 15 of the invention, there is provided the servo control device according to claim 10 or 11, wherein

the position controller has a transfer function characteristic that $\begin{matrix} {u = {{\frac{V_{sum} - {\frac{ffv}{T\quad s}{X(z)}} + \frac{E}{1 - z^{- 1}}}{1 + {G(z)}}\Delta\quad r} - {\frac{\frac{E}{1 - z^{- 1}} + P_{0}}{1 + {G(z)}}\Delta\quad y}}} & \left\lbrack {{Formula}\quad 13} \right\rbrack \end{matrix}$

where u is the speed command, Δy the position output increment value, E a control parameter, ffv a feed-forward gain, and V_(sum), G(z), X(z), P₀ are respectively $\begin{matrix} {{V_{sum} = \frac{v_{sum}}{{Kgv}\left( {1 + C_{D}} \right)}}{{G(z)} = \frac{\left( {g_{1}^{*} - C_{D}} \right)z^{- 1}}{1 + C_{D}}}{{X(z)} = \frac{1 + {g_{1}^{*} \cdot z^{- 1}}}{1 + C_{D}}}{P_{0} = \frac{{- 1} - g_{1}^{*} + {T\quad{s \cdot v_{sum}}}}{{{Kgv} \cdot T}\quad{s\left( {1 + C_{D}} \right)}}}} & \left\lbrack {{Formula}\quad 14} \right\rbrack \end{matrix}$

where g₁*, v_(sum), C_(D) are control parameters, K_(gv) is a constant gain from a speed command to a speed feedback.

According to claim 16 of the invention, there is provided the servo control device according to claim 15, wherein

the speed controller is an I-P controller, and

the feed-forward signal V_(FF) in the feed-forward controller is given from a feed-forward gain ffv by V_(FF)=ffv/Ts·Δr, that the feed-forward gain ffv is given by $\begin{matrix} {{ffv} = {\frac{{D \cdot T}\quad{i\left( {1 + {g\quad 1^{*}}} \right)}^{2}\left( {{T\quad i} - {2\quad T\quad s}} \right)}{{J \cdot K}\quad v\left\{ {{T\quad{i^{2}\left( {1 + {g\quad 1^{*}}} \right)}^{2}} + {{C_{D} \cdot T}\quad{i \cdot T}\quad{s\left( {1 + {g\quad 1^{*}}} \right)}} + {{C_{D} \cdot T}\quad{s^{2}\left( {C_{D} - {g\quad 1^{*}}} \right)}}} \right\}} + \frac{J\left\{ {{\left( {1 + {g\quad 1^{*}}} \right)^{2}K\quad{v \cdot T}\quad i^{2}} + {K\quad{v \cdot T}\quad{s^{2}\left( {C_{D} - {g\quad 1^{*}}} \right)}^{2}} - {T\quad{i\left( {1 + {g\quad 1^{*}}} \right)}\left( {1 + {g\quad 1^{*}} - {{C_{D} \cdot K}\quad{v \cdot T}\quad s} + {g\quad{1^{*} \cdot K}\quad{v \cdot T}\quad s}} \right)}} \right\}}{{J \cdot K}\quad v\left\{ {{T\quad{i^{2}\left( {1 + {g\quad 1^{*}}} \right)}^{2}} + {{C_{D} \cdot T}\quad{i \cdot T}\quad{s\left( {1 + {g\quad 1^{*}}} \right)}} + {{C_{D} \cdot T}\quad{s^{2}\left( {C_{D} - {g\quad 1^{*}}} \right)}}} \right\}}}} & \left\lbrack {{Formula}\quad 15} \right\rbrack \end{matrix}$

where D is a viscous friction coefficient, Jmotor inertia, T_(i) a speed loop integration time in the speed controller, and K_(v) a speed loop gain in the speed controller, and

K₂ as a control gain is given by $\begin{matrix} {K_{2} = {{T\quad{i\left( {1 - {ffv}} \right)}} + {\frac{T\quad s}{1 + g_{1}^{*}}\left\{ {{C_{D}\left( {1 - {ffv}} \right)} - g_{1}^{*}} \right\}} + \frac{{D \cdot T}\quad i}{{J \cdot K}\quad v}}} & \left\lbrack {{Formula}\quad 16} \right\rbrack \end{matrix}$

According to claim 17 of the invention, there is provided the servo control device according to claim 15, wherein

the speed controller is a PI controller,

the speed feed-forward signal V_(FF) in the feed-forward controller is given from a feed-forward gain ffv by V_(FF)=ffv/Ts·Δr,

the feed-forward gain ffv is given by $\begin{matrix} {{ffv} = \frac{\begin{matrix} {{{D \cdot T}\quad{i\left( {1 + {g\quad 1^{*}}} \right)}^{2}\left( {{T\quad i} - {2\quad T\quad s}} \right)} -} \\ {J\left\{ {{\left( {1 + {g\quad 1^{*}}} \right)^{2}T\quad i} - {K\quad{v \cdot T}\quad{s^{2}\left( {C_{D} - {g\quad 1^{*}}} \right)}^{2}}} \right\}} \end{matrix}}{{J \cdot K}\quad{v \cdot T}\quad{s^{2} \cdot {C_{D}\left( {C_{D} - {g\quad 1^{*}}} \right)}}}} & \left\lbrack {{Formula}\quad 17} \right\rbrack \end{matrix}$

where D is a viscous friction coefficient, Jmotor inertia, T_(i) a speed loop integration time in the speed controller, and K_(v) a speed loop gain in the speed controller, and

K₂ as a control gain is given by $\begin{matrix} {K_{2} = {{\frac{T\quad s}{1 + g_{1}^{*}}\left\{ {{C_{D}\left( {1 - {ffv}} \right)} - g_{1}^{*}} \right\}} + {\frac{{D \cdot T}\quad i}{{J \cdot K}\quad v}.}}} & \left\lbrack {{Formula}\quad 18} \right\rbrack \end{matrix}$

EFFECT OF THE INVENTION

According to the invention, it is possible to make zero the positional deviation at a constant speed as well as the positional deviation at a constant acceleration or at constant acceleration and jerk thus providing a high-precision follow-up response. According to the second and eleventh aspects of the invention, it is possible to further reduce the positional deviation after command delivery.

BRIEF DESCRIPTION OF THE DRAWINGS

FIG. 1 is a block diagram of a servo control device showing the first and second embodiment of the invention.

FIG. 2 is a block diagram of a related art servo control device.

FIG. 3 is a block diagram of a servo control device according to Patent Reference 1 using a related art predictive control device.

FIG. 4 is a block diagram showing an FF signal creating filter that uses a related art predictive control device.

FIG. 5 is a block diagram showing an example of predictive control device that uses a related art predictive controller.

FIG. 6 is a block diagram showing an example of FF signal creating filter that uses a related art predictive controller.

FIG. 7 is a block diagram showing a servo control device showing the third embodiment of the invention.

FIG. 8 is a block diagram showing a servo control device showing the third embodiment of the invention.

FIG. 9 is a block diagram showing a servo control device showing the third embodiment of the invention.

DESCRIPTION OF REFERENCE NUMERALS AND SIGNS

-   -   1: Motor     -   2: Speed controller     -   3: Position controller     -   4: First feed-forward controller     -   5: Predictive controller     -   5′: Predictive controller     -   6: Differentiator     -   7: First feed-forward controller     -   21: Filter     -   22: FF signal arithmetic unit     -   23: Memory     -   40: Second feed-forward controller     -   41: Third feed-forward controller     -   42: Adder     -   43: Means of changing feed-forward     -   50: FF signal creating command filter     -   60: Predictive controller     -   70: Second feed-forward controller     -   71: Third feed-forward controller     -   72: Adder     -   73: Means of changing feed-forward     -   100: Memory     -   101: Memory     -   102: Memory     -   103: Memory     -   104: Memory     -   105: Memory     -   106: Arithmetic unit     -   108: Arithmetic unit     -   109: Arithmetic unit

BEST MODE FOR CARRYING OUT THE INVENTION

Embodiments of the invention will be described referring to drawings.

EMBODIMENT 1

FIG. 1 is a block diagram of a servo control device showing Embodiment 1 of the invention. In FIG. 1, a numeral 1 represents a motor, 2 a speed controller, 3 a position controller, 4 a first feed-forward controller, 40 a second feed-forward controller, 41 a third feed-forward controller, and 42 an adder.

The first feed-forward controller 4 includes the second feed-forward controller 40, the third feed-forward controller 41 and the adder 42. Based on a target command increment value Δr as an increment of the sampling period of a target command given from a host controller (not shown), the first feed-forward controller 4 adds, by way of the adder 42, a second speed feed-forward signal V_(FF) as the output of the second feed-forward controller 40 and a third speed feed-forward signal as the output of the third feed-forward controller 41 having a transfer function characteristic K₂ (1−z⁻¹)/Ts²

and outputs the result as a first speed feed-forward signal V_(F2) to a speed controller.

That is, the speed feed-forward signal V_(F2)

is given by VF ₂ =[{K ₂(1−z ⁻¹)Δr}/Ts ² ]+V _(FF)  (4)

where Δr is a target command increment value, Ts a sampling period, K₂ a control gain, and V_(FF) a second speed feed-forward signal, which may be given from the feed-forward gain ffs as V _(FF)(i)=ffv/Ts·Δr  (5)

The servo control device according to this embodiment differs from Patent Reference 1 in that a signal obtained by adding a signal obtained by multiplying the second-order differentiation of the target command to the second speed feed-forward signal V_(FF) is defined as the first speed feed-forward signal V_(F2).

In this case it is assumed that the speed controller 2 is an I-P controller or a PI controller. The position controller 3 may be a known controller such as a predictive controller 5 described in Patent Reference 1. Assume that a discrete time transfer function model from the speed feed-forward signal V_(FF)(i) and the speed command u(i) to the output y(i) of the motor 1 is given by $\begin{matrix} \left\lbrack {{Formula}\quad 19} \right\rbrack & \quad \\ {{y(z)} = {K_{gv}\frac{\begin{matrix} {{\left( {{b_{1}^{\prime}z^{- 1}} + \ldots + {b_{N\quad b}^{\prime}z^{{- N}\quad b}}} \right){u(z)}} +} \\ {\left( {{d_{1}^{\prime}z^{- 1}\quad\ldots} + {d_{N\quad d}^{\prime}z^{{- N}\quad d}}} \right){V_{FF}(z)}} \end{matrix}}{\left( {1 - z^{- 1}} \right)\left( {1 - {a_{1}z^{- 1}} - \ldots - {a_{N\quad a}z^{{- N}\quad a}}} \right)}}} & (6) \end{matrix}$

where K_(gv) is given by a constant gain from the speed command to the speed feedback and Na=1, Nb=2, Nd=2, d_(n)′=b_(n)′(n=1,2), and K=0. Further, the speed command u(i) output from the position controller 3 is given by $\begin{matrix} \left\lbrack {{Formula}\quad 20} \right\rbrack & \quad \\ \begin{matrix} {{u(i)} = {{\sum\limits_{m = 1}^{M}\quad{v_{m}\Delta\quad{r\left( {i + m} \right)}}} - {p_{0}\Delta\quad{y(i)}} + {E\quad{e(i)}} - {g_{1}u\left( {i - 1} \right)} -}} \\ {\sum\limits_{n = 0}^{1}\quad{x_{n}{V_{FF}\left( {i - n} \right)}}} \end{matrix} & (7) \end{matrix}$

and the constants v_(m), E, p₀, g₁, and x_(n)(n=1,2) are given by $\begin{matrix} \left\lbrack {{Formula}\quad 21} \right\rbrack & \quad \\ {{{\beta_{s}^{\prime} = {\sum\limits_{j = 1}^{s}\quad B_{j\quad 0}^{\prime}}},{{Wc}^{\prime} = {\sum\limits_{s = 1}^{M}\quad\beta_{s}^{\prime 2}}},{q_{s}^{*} = {\beta_{s}^{\prime}/W_{c}^{\prime}}}}{{v_{m}^{*} = {\sum\limits_{s = m}^{M}\quad q_{s}^{*}}},{v_{m} = {{\frac{v_{m}^{*}}{K_{gv}\left( {1 + C + C_{D}} \right)}\quad m} = 1}},2,3,\ldots\quad,M}{E = \frac{\left( {1 + \alpha} \right)\quad v_{1}^{*}}{K_{gv}\left( {1 + C + C_{D}} \right)}}{p_{0}^{*} = {\sum\limits_{m = 1}^{M}\quad{v_{m}^{*}A_{m\quad 0}}}}{p_{0} = \frac{p_{0}^{*}}{K_{gv}\left( {1 + C + C_{D}} \right)}}{g_{1}^{*} = {\sum\limits_{m = 1}^{M}\quad{v_{m}^{*}B_{m\quad 1}^{\prime}}}}{g_{1} = \frac{g_{1}^{*} - C_{D}}{1 + C + C_{D}}}{{x_{0} = \frac{1}{1 + C + C_{D}}},{x_{1} = \frac{g_{1}^{*}}{1 + C + C_{D}}}}} & (8) \end{matrix}$

where A_(mn), B_(mn)′ are coefficients calculated from the coefficients a_(mn),−a_(mn), b′₁−b′_(Nb) of the discrete time transfer function model in Expression (6).

From Expressions (5), (7) and (8), the transfer function of the position controller 3 in FIG. 1 is given by $\begin{matrix} \left\lbrack {{Formula}\quad 22} \right\rbrack & \quad \\ {u = {{\frac{V_{sum} - {\frac{ffv}{Ts}{X(z)}} + \frac{E}{1 - z^{- 1}}}{1 + {G(z)}}\Delta\quad r} - {\frac{\frac{E}{1 - z^{- 1}} + P_{0}}{1 + {G(z)}}\Delta\quad y}}} & (9) \end{matrix}$

where V_(sum), G(z), X(z), P₀ are given as follows assuming that C=0: $\begin{matrix} \left\lbrack {{Formula}\quad 23} \right\rbrack & \quad \\ {{v_{sum} = {\sum\limits_{m = 1}^{M}\quad v_{m}^{*}}}{V_{sum} = \frac{v_{sum}}{{Kgv}\left( {1 + C_{D}} \right)}}{{G(z)} = \frac{\left( {g_{1}^{*} - C_{D}} \right)z^{- 1}}{1 + C_{D}}}{{X(z)} = \frac{1 + {g_{1}^{*} \cdot z^{- 1}}}{1 + C_{D}}}{P_{0} = \frac{{- 1} - g_{1}^{*} + {{Ts} \cdot v_{sum}}}{{Kgv} \cdot {{Ts}\left( {1 + C_{D}} \right)}}}} & (10) \end{matrix}$

The position controller 3 in the servo control device according to this embodiment is not necessarily a predictive control system but may be an arbitrary position controller satisfying Expressions (9) and (10). As long as the speed controller 2 is an I-P controller, the control gain K₂ in the first feed-forward controller 4 may be given by $\begin{matrix} \left\lbrack {{Formula}\quad 24} \right\rbrack & \quad \\ {K_{2} = {{{Ti}\left( {1 - {ffv}} \right)} + {\frac{Ts}{1 + g_{1}^{*}}\left( {{C_{D}\left( {1 - {ffv}} \right)} - g_{1}^{*}} \right)} + \frac{D \cdot {Ti}}{J \cdot {Kv}}}} & (11) \end{matrix}$

where D is a viscous friction coefficient, Jmotor inertia, T_(i) a speed loop integration time constant in the speed controller, and K_(v) a speed loop gain in the speed controller thus making zero the deviation at a constant acceleration. In case the speed controller 2 is a PI controller, the control gain K₂ may be given by $\begin{matrix} \left\lbrack {{Formula}\quad 25} \right\rbrack & \quad \\ {K_{2} = {{\frac{Ts}{1 + g_{1}^{*}}\left( {{C_{D}\left( {1 - {ffv}} \right)} - g_{1}^{*}} \right)} + \frac{D \cdot {Ti}}{J \cdot {Kv}}}} & (12) \end{matrix}$

so as to make zero the deviation at a constant acceleration.

Embodiment 2

The position controller 3 in the servo control device shown in FIG. 1 may be a position controller of another configuration in place of a predictive controller. In case the position controller 3 is a position proportional controller and the speed controller 2 is a speed I-P controller or a speed PI controller,

the deviation at a constant acceleration is made zero by using K2=DT _(i)/(JK _(v))

ffv=1.

Embodiment 3

FIG. 7 shows the first feed-forward controller 4 in the servo control device shown in FIG. 1 including means of changing feed-forward 43 added therein. The means of changing feed-forward 43 makes zero the output of the third feed-forward controller 41 or multiplies the output of the third feed-forward controller 41 by a present gain and outputs the result, thereby further reducing the positional deviation after delivery of command.

Embodiment 4

FIG. 8 is a block diagram of a servo control device to illustrate Embodiment 4 of the invention. In FIG. 8, the servo control device includes a first feed-forward controller 7, a position controller 3, and a speed controller 2. The servo control device controls the motor 1.

The first feed-forward controller 7 includes a second feed-forward controller 70, a third feed-forward controller 71 and an adder 72. Based on a target command increment value as an increment of the sampling period of a target command given from a host controller (not shown), the first feed-forward controller 7 adds, by way of the adder 72, a related art speed feed-forward signal V_(FF) as the output of the second feed-forward controller 70 and the output of the third feed-forward controller 71 having a transfer function characteristic $\begin{matrix} {\frac{K_{2}}{{Ts}^{2}}\left( {1 - z^{- 1}} \right)} & \left\lbrack {{Formula}\quad 26} \right\rbrack \end{matrix}$

and generates the result as a speed feed-forward signal V_(F2).

That is, the speed feed-forward signal V_(F2) is given by $\begin{matrix} \left\lbrack {{Formula}\quad 27} \right\rbrack & \quad \\ {V_{F\quad 2} = {{\frac{K_{2}}{{Ts}^{2}}\left( {1 - z^{- 1}} \right)\Delta\quad r} + V_{FF}}} & (13) \end{matrix}$

where Δr is a target command increment value, Ts a sampling period, K₂ a control gain, and V_(FF) a speed feed-forward signal that is generally used, which may be given from the feed-forward gain ffs as $\begin{matrix} \left\lbrack {{Formula}\quad 28} \right\rbrack & \quad \\ {V_{FF} = {\frac{ffv}{Ts}\Delta\quad r}} & (14) \end{matrix}$

The servo control device according to this embodiment differs from Patent Reference 1 in that a signal obtained by adding a signal obtained by multiplying the second-order differentiation of the target command to the typical speed feed-forward signal V_(FF) is defined as the speed feed-forward signal V_(F2)

In this case it is assumed that the speed controller 2 is an I-P controller or a PI controller. The position controller 3 may be a known controller such as a predictive controller 5 described in Patent Reference 1. Assume that a discrete time transfer function model from the speed feed-forward signal V_(FF)(i) and the speed command u(i) to the output y(i) of the motor 1 is given by

[Formula 29] y(z)=K _(gv){(b ₁ ′z ⁻¹ + . . . +b _(Nb) ′z ^(−Nb))u(z)+(d ₁ ′z ⁻¹ + . . . +d _(Nd) ′z ^(−Nd))V _(FF)(z)}/{(1−z ⁻¹)(1−a ₁ z ⁻¹ − . . . −a _(Na) z ^(−Na))}  (15)

where K_(gv) is given by a constant gain from the speed command to the speed feedback and Na=1, Nb=2, Nd=2, d_(n)′=b_(n)′(n=1,2), and K=0. Further, the speed command u(i) output from the position controller 3 is given by $\begin{matrix} \left\lbrack {{Formula}\quad 30} \right\rbrack & \quad \\ \begin{matrix} {{u(i)} = {{\sum\limits_{m = 1}^{M}\quad{v_{m}\Delta\quad{r\left( {i + m} \right)}}} - {p_{0}\Delta\quad y(i)} +}} \\ {{{Ee}(i)} - {g_{1}{u\left( {i - 1} \right)}} - {\sum\limits_{n = 0}^{1}\quad{x_{n}{V_{FF}\left( {i - n} \right)}}}} \end{matrix} & (16) \end{matrix}$

and the constants v_(m), E, p₀, g₁, and x_(n)(n=1,2) are given by $\begin{matrix} \left\lbrack {{Formula}\quad 31} \right\rbrack & \quad \\ {{{\beta_{s}^{\prime} = {\sum\limits_{j = 1}^{s}\quad B_{j\quad 0}^{\prime}}},{W_{c}^{\prime} = {\sum\limits_{s = 1}^{M}\quad\beta_{s}^{\prime 2}}},{q_{s}^{*} = {\beta_{s}^{\prime}/W_{c}^{\prime}}}}{{v_{m}^{*} = {\sum\limits_{s = m}^{M}\quad q_{s}^{*}}},{v_{m} = \frac{v_{m}^{*}}{K_{gv}\left( {1 + C + C_{D}} \right)}}\quad,\quad{m = 1},2,\ldots\quad,M}{E = \frac{\left( {1 + \alpha} \right)\quad v_{1}^{*}}{K_{gv}\left( {1 + C + C_{D}} \right)}}{p_{0}^{*} = {\sum\limits_{m = 1}^{M}\quad{v_{m}^{*}A_{m\quad 0}}}}{p_{0} = \frac{p_{0}^{*}}{K_{gv}\left( {1 + C + C_{D}} \right)}}{g_{1}^{*} = {\sum\limits_{m = 1}^{M}\quad{v_{m}^{*}B_{m\quad 1}^{\prime}}}}{g_{1} = \frac{g_{1}^{*} - C_{D}}{1 + C + C_{D}}}{{x_{0} = \frac{1}{1 + C + C_{D}}},{x_{1} = \frac{g_{1}^{*}}{1 + C + C_{D}}}}} & (17) \end{matrix}$

where A_(mn), B_(mn)′ are coefficients calculated from the coefficients a_(mn),−a_(mn), b′₁−b′_(Nb) of the discrete time transfer function model in Expression (15).

From Expressions (14), (16) and (17), the transfer function of the position controller 3 in FIG. 8 is given by $\begin{matrix} \left\lbrack {{Formula}\quad 32} \right\rbrack & \quad \\ {u = {{\frac{V_{sum} - {\frac{ffv}{T\quad s}{X(z)}} + \frac{E}{1 - z^{- 1}}}{1 + {G(z)}}\Delta\quad r} - {\frac{\frac{E}{1 - z^{- 1}} + P_{0}}{1 + {G(z)}}\Delta\quad y}}} & (18) \end{matrix}$

where V_(sum), G(z), X(z), P₀ are given as follows assuming that C=0: $\begin{matrix} \left\lbrack {{Formula}\quad 33} \right\rbrack & \quad \\ {{v_{sum} = {\sum\limits_{m = 1}^{M}\quad v_{m}^{*}}}{V_{sum} = \frac{v_{sum}}{K\quad g\quad{v\left( {1 + C_{D}} \right)}}}{{G(z)} = \frac{\left( {g_{1}^{*} - C_{D}} \right)z^{- 1}}{1 + C_{D}}}{{X(z)} = \frac{1 + {g_{1}^{*} \cdot z^{- 1}}}{1 + C_{D}}}{P_{0} = \frac{{- 1} - g_{1}^{*} + {T\quad{s \cdot v_{sum}}}}{K\quad g\quad{v \cdot T}\quad{s\left( {1 + C_{D}} \right)}}}} & (19) \end{matrix}$

The position controller 3 in the servo control device according to this embodiment is not necessarily a predictive control system but may be an arbitrary position controller satisfying Expressions (18) and (19). As long as the speed controller 2 is an I-P controller, the speed feed-forward gain ffv in the first feed-forward controller 7 may be given by $\begin{matrix} {{ffv} = \frac{\begin{matrix} {{{D \cdot T}\quad{i\left( {1 + {g\quad 1^{*}}} \right)}^{2}\left( {{T\quad i} - {2\quad T\quad s}} \right)} +} \\ {J\begin{Bmatrix} {{\left( {1 + {g\quad 1^{*}}} \right)^{2}K\quad{v \cdot T}\quad i^{2}} + {K\quad{v \cdot}}} \\ {{T\quad{s^{2}\left( {C_{D} - {g\quad 1^{*}}} \right)}^{2}} - {T\quad i\left( {1 + {g\quad 1^{*}}} \right)\left( {1 + {g\quad 1^{*}} -} \right.}} \\ \left. {{{C_{D} \cdot K}\quad{v \cdot T}\quad s} + {g\quad{1^{*} \cdot K}\quad{v \cdot T}\quad s}} \right) \end{Bmatrix}} \end{matrix}}{{J \cdot K}\quad v\begin{Bmatrix} {{T\quad{i^{2}\left( {1 + {g\quad 1^{*}}} \right)}^{2}} + {{C_{D} \cdot T}\quad{i \cdot}}} \\ {{T\quad s\left( {1 + {g\quad 1^{*}}} \right)} +} \\ {{C_{D} \cdot T}\quad{s^{2}\left( {C_{D} - {g\quad 1^{*}}} \right)}} \end{Bmatrix}}} & \left\lbrack {{Formula}\quad 34} \right\rbrack \end{matrix}$

where D is a viscous friction coefficient, Jmotor inertia, T_(i) a speed loop integration time constant in the speed controller, and K_(v) a speed loop gain in the speed controller and the control gain K₂ is given by $\begin{matrix} {K_{2} = {{T\quad{i\left( {1 - {ffv}} \right)}} + {\frac{T\quad s}{1 + g_{1}^{*}}\left( {{C_{D}\left( {1 - {ffv}} \right)} - g_{1}^{*}} \right)} + \frac{{D \cdot T}\quad i}{{J \cdot K}\quad v}}} & \left\lbrack {{Formula}\quad 35} \right\rbrack \end{matrix}$

so that when a target command to provide a constant acceleration $\begin{matrix} {r = \frac{{A \cdot T}\quad{s^{2} \cdot z^{- 1} \cdot \left( {1 + z^{- 1}} \right)}}{2 \cdot \left( {1 - z^{- 1}} \right)^{3}}} & \left\lbrack {{Formula}\quad 36} \right\rbrack \end{matrix}$

(where A is a constant gain of acceleration) is input, $\begin{matrix} \left\lbrack {{Formula}\quad 37} \right\rbrack & \quad \\ {{the}\quad{value}\quad{of}\quad{the}\quad{expression}} & (20) \\ {\lim\limits_{z->1}{\left( {1 - z^{- 1}} \right){{\mathbb{e}}(z)}}} & \quad \end{matrix}$

is 0 from the theorem of a final value, so that the deviation at a constant acceleration is zero. Note that e(z) is a z conversion of the deviation e between the target command and the output of the motor 1. Similarly, when a target command that provides a constant jerk $\begin{matrix} {r = \frac{J\quad{r \cdot T}\quad{s^{3} \cdot z^{- 2} \cdot \left( {1 + {4 \cdot z^{- 1}} + z^{- 2}} \right)}}{6 \cdot \left( {1 - z^{- 1}} \right)^{4}}} & \left\lbrack {{Formula}\quad 38} \right\rbrack \end{matrix}$

(where Jr is a constant gain of a jerk) is input, the value of Expression (20) becomes 0 so that the deviation at a constant jerk is zero.

In case the speed controller 2 is a PI controller, the speed feed-forward gain ffv is given by $\begin{matrix} {{f\quad f\quad v} = \frac{\begin{matrix} {{{D \cdot T}\quad{i\left( {1 + {g\quad 1^{*}}} \right)}^{2}\left( {{T\quad i} - {2\quad T\quad s}} \right)} -} \\ {J\left\{ {{\left( {1 + {g\quad 1^{*}}} \right)^{2}T\quad i} - {K\quad{v \cdot T}\quad{s^{2}\left( {C_{D} - {g\quad 1^{*}}} \right)}^{2}}} \right\}} \end{matrix}}{{J \cdot K}\quad{v \cdot T}\quad{s^{2} \cdot {C_{D}\left( {C_{D} - {g\quad 1^{*}}} \right)}}}} & \left\lbrack {{Formula}\quad 39} \right\rbrack \end{matrix}$

and the control gain K₂ is given by $\begin{matrix} {K_{2} = {{\frac{T\quad s}{1 + g_{1}^{*}}\left( {{C_{D}\left( {1 - {ffv}} \right)} - g_{1}^{*}} \right)} + \frac{{D \cdot T}\quad i}{{J \cdot K}\quad v}}} & \left\lbrack {{Formula}\quad 40} \right\rbrack \end{matrix}$

so that the deviation at constant acceleration and jerk is zero, same as the case of the I-P controller.

Embodiment 5

FIG. 9 shows the first feed-forward controller 7 in the servo control device shown in FIG. 8 including means of changing feed-forward 73 added therein. The means of changing feed-forward 73 makes zero the output of the third feed-forward controller 71 or multiplies the output of the third feed-forward controller 71 by a present gain and outputs the result, thereby further reducing the positional deviation after delivery of command.

While the invention are described in detail referring to specific embodiments, those skilled in the art will recognize that various changes and modifications can be made in it without departing the spirit and scope thereof.

This application is based on the Japanese Patent Application Nos. 2005-106437 and 2005-106438 filed Apr. 1, 2005 and the contents thereof are herein incorporated by reference.

INDUSTRIAL APPLICABILITY

By using, as a speed feed-forward signal, a signal obtained by adding a signal obtained by multiplying the differential of a target command by a feed-forward gain ffv and a signal obtained by multiplying the second-order differentiation of the target command by a control gain K2, it is possible to make zero the positional deviation at a constant acceleration or at constant acceleration and jerk thus providing a high-precision follow-up response. It is thus possible to apply the invention to a machine that performs synchronized control.

[FIG. 1]

-   1: MOTOR -   2: SPEED CONTROLLER -   3: POSITION CONTROLLER -   4: FIRST FEED-FORWARD CONTROLLER -   40: SECOND FEED-FORWARD CONTROLLER -   41: THIRD FEED-FORWARD CONTROLLER -   42: ADDER -   A1: SPEED FEED-FORWARD SIGNAL V_(F2) -   A2: TARGET COMMAND INCREMENT VALUE ΔR -   A3: SPEED COMMAND U     [FIG. 2] -   1: MOTOR -   2: SPEED CONTROLLER -   5: PREDICTIVE CONTROLLER -   40: SECOND FEED-FORWARD CONTROLLER -   A1: POSITION CONTROLLER V_(FF) -   A2: TARGET COMMAND INCREMENT VALUE ΔR -   A3: SPEED COMMAND U     [FIG. 3] -   1: MOTOR 2: SPEED CONTROLLER 5′: PREDICTIVE CONTROLLER -   50: FF SIGNAL CREATING COMMAND FILTER -   A1: FUTURE TARGET COMMAND

A2: SPEED COMMAND U

[FIG. 4]

-   21: FILTER -   22: FF SIGNAL ARITHMETIC UNIT -   50: FF SIGNAL CREATING COMMAND FILTER -   A1: FUTURE TARGET COMMAND     [FIG. 5] -   5: PREDICTIVE CONTROLLER -   22: FF SIGNAL ARITHMETIC UNIT -   106: ARITHMETIC UNIT -   A1: TARGET COMMAND INCREMENT VALUE     [FIG. 6] -   22: FF SIGNAL ARITHMETIC UNIT -   40: SECOND FEED-FORWARD CONTROLLER -   A1: TARGET COMMAND INCREMENT VALUE     [FIG. 7] -   1: MOTOR -   2: SPEED CONTROLLER -   3: POSITION CONTROLLER -   4: FIRST FEED-FORWARD CONTROLLER -   40: SECOND FEED-FORWARD CONTROLLER -   41: THIRD FEED-FORWARD CONTROLLER -   42: ADDER -   43: MEANS OF CHANGING FEED-FORWARD -   A1: SPEED FEED-FORWARD SIGNAL V_(F2) -   A2: TARGET COMMAND INCREMENT VALUE -   A3: SPEED COMMAND U     [FIG. 8] -   1: MOTOR -   2: SPEED CONTROLLER -   3: POSITION CONTROLLER -   7: FIRST FEED-FORWARD CONTROLLER -   70: SECOND FEED-FORWARD CONTROLLER -   71: THIRD FEED-FORWARD CONTROLLER -   72: ADDER -   43: MEANS OF CHANGING FEED-FORWARD -   A1: SPEED FEED-FORWARD SIGNAL V_(F2) -   A2: TARGET COMMAND INCREMENT VALUE -   A3: SPEED COMMAND U     [FIG. 9] -   1: MOTOR -   2: SPEED CONTROLLER -   3: POSITION CONTROLLER -   7: FIRST FEED-FORWARD CONTROLLER -   70: SECOND FEED-FORWARD CONTROLLER -   71: THIRD FEED-FORWARD CONTROLLER -   72: ADDER -   73: MEANS OF CHANGING FEED-FORWARD -   A1: SPEED FEED-FORWARD SIGNAL V_(F2) -   A2: TARGET COMMAND INCREMENT VALUE -   A3: SPEED COMMAND U 

1. A servo control device comprising: a speed controller for performing speed control of a motor; a position controller for inputting a target command increment value as an increment of the sampling period of a target command and a position output increment value as an increment of the sampling period of the position output of the motor and outputting a speed command to the speed controller; and a first feed-forward controller for inputting the target command increment value and outputting a first speed feed-forward signal to the speed controller; wherein the first feed-forward controller adds a third speed feed-forward signal obtained by multiplying the second-order differentiation of the target command by a control gain to a second speed feed-forward signal V_(FF), outputs as a first speed feed-forward signal V_(F2) the resulting signal to the speed controller and sets the control gain so that the deviation between the target position and the position output of the motor will be zero at a constant acceleration.
 2. A servo control device comprising: a speed controller for performing speed control of a motor; a position controller for inputting a target command increment value as an increment of the sampling period of a target command and a position output increment value as an increment of the sampling period of the position output of the motor and outputting a speed command to the speed controller; and a first feed-forward controller for inputting the target command increment value and outputting a first speed feed-forward signal to the speed controller; wherein the first feed-forward controller adds a third speed feed-forward signal obtained by multiplying the second-order differentiation of the target command by a control gain to a second speed feed-forward signal V_(FF), outputs as a first speed feed-forward signal V_(F2) the resulting signal to the speed controller and sets the control gain so that the deviation between the target position and the position output of the motor will be zero at a constant acceleration and, when the target command increment value Δr is equal to or below a preset threshold at deceleration, makes zero or multiplies the output of the third feed-forward signal by a present gain and outputs the resulting signal.
 3. The servo control device according to claim 1, wherein the first feed-forward controller generates a speed feed-forward signal V_(F2) in accordance with the expression $\begin{matrix} {V_{F\quad 2} = {{\frac{K_{2}}{T\quad s^{2}}\left( {1 - z^{- 1}} \right)\Delta\quad r} + V_{F\quad F}}} & \left\lbrack {{Formula}\quad 1} \right\rbrack \end{matrix}$ where Δr is the target command increment value, Ts a sampling period, K₂ a control gain set so that the deviation between the target position and the position output of the motor will be zero, and z⁻¹ a delay corresponding to one sampling period, and outputs the signal to the speed controller.
 4. The servo control device according to claim 2, wherein the first feed-forward controller generates a speed feed-forward signal V_(F2) in accordance with the expression $\begin{matrix} {V_{F\quad 2} = {{\frac{K_{2}}{T\quad s^{2}}\left( {1 - z^{- 1}} \right)\Delta\quad r} + V_{F\quad F}}} & \left\lbrack {{Formula}\quad 2} \right\rbrack \end{matrix}$ where Δr is the target command increment value, Ts a sampling period, K₂ a control gain set so that the deviation between the target position and the position output of the motor will be zero, and z⁻¹ a delay corresponding to one sampling period and, only when the target command increment value Δr is equal to or below a preset threshold at deceleration, generates a speed feed-forward signal V_(F2) in accordance with the expression $\begin{matrix} {V_{F\quad 2} = {{V_{F\quad F}{\quad\quad}{or}\quad V_{F\quad 2}} = {{\frac{K_{2}K_{3}}{T\quad s^{2}}\left( {1 - z^{- 1}} \right)\Delta\quad r} + V_{F\quad F}}}} & \left\lbrack {{Formula}\quad 3} \right\rbrack \end{matrix}$ where K₃ is a gain, and outputs the signal to the speed controller.
 5. The servo control device according to claim 1 or 2, wherein the position controller is a predictive controller for inputting the target command increment value Δr(i+M) at an M sampling future and the position output increment value Δr(i−K) before K (K≧0) sampling at the current time i, and outputting a speed command u(i) that minimizes the evaluation function $\begin{matrix} {J = {{\sum\limits_{m = 1}^{M}\quad{w_{m}\left\{ {{e^{*}\left( {i + m} \right)} + {\alpha\quad{e\left( {i - K} \right)}}} \right\}^{2}}} + {c\left\{ {u(i)} \right\}^{2}} + {c_{d}\left\{ {\Delta\quad{u(i)}} \right\}^{2}}}} & \left\lbrack {{Formula}\quad 4} \right\rbrack \end{matrix}$ will be minimum, wherein e*(i+m) is a deviation predicted value at an m sampling future time, w_(m), α are coefficients to multiply a deviation by, c and c_(d) are coefficients to multiply a speed command u(i) and its increment value Δu(i).
 6. The servo control device according to claim 3 or 4, wherein the position controller has the characteristic of the transfer function $\begin{matrix} {u = {{\frac{V_{sum} - {\frac{f\quad f\quad v}{T\quad s}{X(z)}} + \frac{E}{1 - z^{- 1}}}{1 + {G(z)}}\Delta\quad r} - {\frac{\frac{E}{1 - z^{- 1}} + P_{0}}{1 + {G(z)}}\Delta\quad y}}} & \left\lbrack {{Formula}\quad 5} \right\rbrack \end{matrix}$ where u is the speed command, Δy the position output increment value, E a control parameter, ffv a feed-forward gain, and V_(sum), G(z), X(z), P₀ are respectively V _(sum) =v _(sum) /{K _(gv)(1+C _(D))} G(z)=(g ₁ *−C _(D))z ⁻¹/(1+C _(D)) X(z)=(1+g ₁ *·z ⁻¹(1+C _(D)) P ₀=(−1−g ₁ *+T _(s) v _(sum))/{K _(gv) T _(s)(1+C _(D))} and g₁*, V_(sum), C_(D) are controller parameters and K_(gv) a constant gain from a speed command to a speed feedback.
 7. The servo control device according to claim 6, wherein the speed controller is an I-P controller, the speed feed-forward signal in the feed-forward controller is given from a feed-forward gain ffv by V _(FF) =ffv/Ts·Δr, and K₂ as a control gain is given by K ₂ =T _(i)·(1−ffv)+T _(s) {C _(D)(1−ffv)−g ₁*}/(1+g ₁*)+D·T _(i)/(J·K _(v)) where D is a viscous friction coefficient, Jmotor inertia, T_(i) a speed loop integration time in the speed controller, and K_(v) a speed loop gain in the speed controller.
 8. The servo control device according to claim 6, wherein the speed controller is a PI controller, the second speed feed-forward signal V_(FF) in the first feed-forward controller is given from the feed-forward gain ffv by V _(FF) =ffv/Ts·Δr, and K₂ as a control gain is given by K ₂ =T _(s) {C _(D)(1−ffv)−g ₁*}/(1+g ₁*)+D·T _(i)/(J·K _(v)) where D is a viscous friction coefficient, Jmotor inertia, T_(i) a speed loop integration time in the speed controller, and K_(v) a speed loop gain in the speed controller.
 9. The servo control device according to claim 3 or 4, wherein the position controller is a proportional controller, the speed controller is a PI controller or an I-P controller, and the speed feed-forward signal V_(FF) in the feed-forward controller is given from the feed-forward gain ffv by V _(FF) =ffv/Ts·Δr and K₂ and ffv as parameters are given by K ₂ =D·T _(i)/(J·K _(v)) ffv=1 where D is a viscous friction coefficient, Jmotor inertia, T_(i) a speed loop integration time in the speed controller, and K_(v) a speed loop gain in the speed controller.
 10. A servo control device that makes control so as to match the output of a motor having viscous friction with a target command, the device comprising: a speed controller for performing speed control of the motor; a position controller for inputting a target command increment value as an increment of the sampling period of the target command and a position output increment value as an increment of the sampling period of the position output of the motor and outputting a speed command to the speed controller; and a feed-forward controller for inputting the target command increment value and outputting a speed feed-forward signal to the speed controller; wherein the feed-forward controller adds a third speed feed-forward signal obtained by multiplying the second-order differentiation of the target command by a control gain to a second speed feed-forward signal V_(FF), and outputs as a speed feed-forward signal V_(F2) the resulting signal, and the gain ffv and the gain K₂ are set so that the deviation between the target command and the position output of the motor will be zero at a constant acceleration and at a constant jerk.
 11. A servo control device that makes control so as to match the output of a motor having viscous friction with a target command, the device comprising: a speed controller for performing speed control of the motor; a position controller for inputting a target command increment value as an increment of the sampling period of the target command and a position output increment value as an increment of the sampling period of the position output of the motor and outputting a speed command to the speed controller; and a feed-forward controller for inputting the target command increment value and outputting a speed feed-forward signal to the speed controller; wherein the feed-forward controller adds a third speed feed-forward signal obtained by multiplying the second-order differentiation of the target command by a control gain to a second speed feed-forward signal V_(FF) and outputs as a speed feed-forward signal V_(F2) the resulting signal, the gain ffv and the gain K₂ are set so that the deviation between the target command and the position output of the motor will be zero at a constant acceleration and at a constant jerk, and when the target command increment value Δr is equal to or below a preset threshold at deceleration, the feed-forward controller makes zero the gain K₂ or sets a gain obtained by multiplying the gain K₂ by a preset gain K₃.
 12. The servo control device according to claim 10, wherein the feed-forward controller is a feed-forward controller that generates the speed feed-forward signal V_(F2) in accordance with $\begin{matrix} {V_{F\quad 2} = {{\frac{K_{2}}{T\quad s^{2}}\left( {1 - z^{- 1}} \right)\Delta\quad r} + V_{F\quad F}}} & \left\lbrack {{Formula}\quad 6} \right\rbrack \end{matrix}$ where Δr is the target command increment value, Ts a sampling period, K₂ a control gain, and z⁻¹ a delay corresponding to one sampling period.
 13. The servo control device according to claim 11, wherein the feed-forward controller is a feed-forward controller that generates the speed feed-forward signal V_(F2) in accordance with $\begin{matrix} {V_{F\quad 2} = {{\frac{K_{2}}{T\quad s^{2}}\left( {1 - z^{- 1}} \right)\Delta\quad r} + V_{F\quad F}}} & \left\lbrack {{Formula}\quad 7} \right\rbrack \end{matrix}$ where Δr is the target command increment value, Ts a sampling period, K₂ a control gain, and z⁻¹ a delay corresponding to one sampling period, and when the target command increment value is equal to or below a preset threshold at deceleration, generates a speed feed-forward signal V_(F2) in accordance with the expression $\begin{matrix} {V_{F\quad 2} = {{V_{F\quad F}{\quad\quad}{or}\quad V_{F\quad 2}} = {{\frac{K_{2}K_{3}}{T\quad s^{2}}\left( {1 - z^{- 1}} \right)\Delta\quad r} + V_{F\quad F}}}} & \left\lbrack {{Formula}\quad 8} \right\rbrack \end{matrix}$ where K₃ is a gain.
 14. The servo control device according to claim 10 or 11, wherein the position controller is a predictive controller for inputting the target command increment value Δr(i+M) at an M sampling future and the position output increment value Δr(i−K) before K (K≧0) sampling at the current time I, and outputting a speed command u(i) that minimizes the evaluation function $\begin{matrix} {J = {{\sum\limits_{m = 1}^{M}\quad{w_{m}\left\{ {{e^{*}\left( {i + m} \right)} + {\alpha\quad{e\left( {i - K} \right)}}} \right\}^{2}}} + {c\left\{ {u(i)} \right\}^{2}} + {c_{d}\left\{ {\Delta\quad{u(i)}} \right\}^{2}}}} & \left\lbrack {{Formula}\quad 9} \right\rbrack \end{matrix}$ will be minimum, wherein e*(i+m) is a deviation predicted value at an m sampling future time, w_(m), α are coefficients to multiply a deviation by, c and c_(d) are coefficients to multiply a speed command u(i) and its increment value Δu(i).
 15. The servo control device according to claim 10 or 11, wherein the position controller has a transfer function characteristic that $\begin{matrix} {u = {{\frac{V_{sum} - {\frac{ffv}{T\quad s}{X(z)}} + \frac{E}{1 - z^{- 1}}}{1 + {G(z)}}\Delta\quad r} - {\frac{\frac{E}{1 - z^{- 1}} + P_{0}}{1 + {G(z)}}\Delta\quad y}}} & \left\lbrack {{Formula}\quad 10} \right\rbrack \end{matrix}$ where u is the speed command, Δy the position output increment value, E a control parameter, ffv a feed-forward gain, and V_(sum), G(z), X(z), P₀ are respectively $\begin{matrix} {{V_{sum} = \frac{v_{sum}}{K\quad g\quad{v\left( {1 + C_{D}} \right)}}}{{G(z)} = \frac{\left( {g_{1}^{*} - C_{D}} \right)z^{- 1}}{1 + C_{D}}}{{X(z)} = \frac{1 + {g_{1}^{*} \cdot z^{- 1}}}{1 + C_{D}}}{P_{0} = \frac{{- 1} - g_{1}^{*} + {T\quad{s \cdot v_{sum}}}}{K\quad g\quad{v \cdot T}\quad{s\left( {1 + C_{D}} \right)}}}} & \left\lbrack {{Formula}\quad 11} \right\rbrack \end{matrix}$ where g₁*, v_(sum), C_(D) are control parameters, K_(gv) is a constant gain from a speed command to a speed feedback.
 16. The servo control device according to claim 15, wherein the speed controller is an I-P controller, and the feed-forward signal V_(FF) in the feed-forward controller is given from a feed-forward gain ffv by V_(FF)=ffv/Ts·Δr, that the feed-forward gain ffv is given by $\begin{matrix} {{f\quad f\quad v} = {\frac{{D \cdot T}\quad{i\left( {1 + {g\quad 1^{*}}} \right)}^{2}\left( {{T\quad i} - {2\quad T\quad s}} \right)}{{J \cdot K}\quad v\left\{ {{T\quad{i^{2}\left( {1 + {g\quad 1^{*}}} \right)}^{2}} + {{C_{D} \cdot T}\quad{i \cdot T}\quad{s\left( {1 + {g\quad 1^{*}}} \right)}} + {{C_{D} \cdot T}\quad{s^{2}\left( {C_{D} - {g\quad 1^{*}}} \right)}}} \right\}} + {\frac{\left( {J\left\{ {{\left( {1 + {g\quad 1^{*}}} \right)^{2}K\quad{v \cdot T}\quad i^{2}} + {K\quad{v \cdot T}\quad{s^{2}\left( {C_{D} - {g\quad 1^{*}}} \right)}^{2}} - {T\quad{i\left( {1 + {g\quad 1^{*}}} \right)}\left( {1 + {g\quad 1^{*}} - {{C_{D} \cdot K}\quad{v \cdot T}\quad s} + {g\quad{1^{*} \cdot K}\quad{v \cdot T}\quad s}} \right)}} \right\}} \right)}{\left( {{J \cdot K}\quad v\left\{ {{T\quad{i^{2}\left( {1 + {g\quad 1^{*}}} \right)}^{2}} + {{C_{D} \cdot T}\quad{i \cdot T}\quad{s\left( {1 + {g\quad 1^{*}}} \right)}} + {{C_{D} \cdot T}\quad{s^{2}\left( {C_{D} - {g\quad 1^{*}}} \right)}}} \right\}} \right.}{\quad\quad}}}} & \left\lbrack {{Formula}\quad 12} \right\rbrack \end{matrix}$ where D is a viscous friction coefficient, Jmotor inertia, T_(i) a speed loop integration time in the speed controller, and K_(v) a speed loop gain in the speed controller, and K₂ as a control gain is given by $\begin{matrix} {K_{2} = {{T\quad{i\left( {1 - {f\quad f\quad v}} \right)}} + {\frac{T\quad s}{1 + g_{1}^{*}}\left\{ {{C_{D}\left( {1 - {f\quad f\quad v}} \right)} - g_{1}^{*}} \right\}} + \frac{{D \cdot T}\quad i}{{J \cdot K}\quad v}}} & \left\lbrack {{Formula}\quad 13} \right\rbrack \end{matrix}$
 17. The servo control device according to claim 15, wherein the speed controller is a PI controller, the speed feed-forward signal V_(FF) in the feed-forward controller is given from a feed-forward gain ffv by V_(FF)=ffv/Ts·Δr, the feed-forward gain ffv is given by $\begin{matrix} {{f\quad f\quad v} = \frac{\begin{matrix} {{{D \cdot T}\quad{i\left( {1 + {g\quad 1^{*}}} \right)}^{2}\left( {{T\quad i} - {2\quad T\quad s}} \right)} -} \\ {J\left\{ {{\left( {1 + {g\quad 1^{*}}} \right)^{2}T\quad i} - {K\quad{v \cdot T}\quad{s^{2}\left( {C_{D} - {g\quad 1^{*}}} \right)}^{2}}} \right\}} \end{matrix}}{{J \cdot K}\quad{v \cdot T}\quad{s^{2} \cdot {C_{D}\left( {C_{D} - {g\quad 1^{*}}} \right)}}}} & \left\lbrack {{Formula}\quad 14} \right\rbrack \end{matrix}$ where D is a viscous friction coefficient, Jmotor inertia, T_(i) a speed loop integration time in the speed controller, and K_(v) a speed loop gain in the speed controller, and K₂ as a control gain is given by $\begin{matrix} {K_{2} = {{\frac{T\quad s}{1 + g_{1}^{*}}\left\{ {{C_{D}\left( {1 - {f\quad f\quad v}} \right)} - g_{1}^{*}} \right\}} + {\frac{{D \cdot T}\quad i}{{J \cdot K}\quad v}.}}} & \left\lbrack {{Formula}\quad 15} \right\rbrack \end{matrix}$ 